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Abstract 

This paper considers the trajectory tracking problem for uncertain rigid-link, flexible- 
joint manipulators, and presents anew intelligent controller as a solution to this problem. 
The prop osed control strategy is simple and computationally efficient, requires lit tie infor- 
mation concerning either the manipulator or actuator/ transmission models, and ensures 
uniform boundedness of all signals and arbitrarily accurate task-space trajectory tracking. 


1. Introduction 

The problem of controlling the motion of robotic manipulators in the presence of 
incomplete information concerning the system model has received considerable attention 
during the past decade, and much progress has been made in this area. However most 
of the controllers proposed as solutions to this problem have been designed by neglecting 
any flexibility associated with the actuator/transmission system and assuming that the 
actuators are rigidly connected to the manipulator links, As demonstrated in [e.g., 1], 
joint flexibilities constitute an important component of the complete manipulator dynamic 
model and thus should be addressed in the controller development process. Recognizing 
the potential difficulties associated with ignoring the effects of joint flexibility, several 
researchers have recently considered the problem of controlling rigid-link, flexible-joint 
(RLFJ) manipulators [e.g., 2-11]. In much of this work, the controller development requires 
full knowledge of the complex dynamic models for the manipulator and actuator systems 
[e.g., 2-5], Research in which controllers are designed with the capability to compensate 
for uncertainty in the manipulator/actuator system includes adaptive schemes developed 
using a singular perturbation approach [6,7], which can be used if the joints are sufficiently 
stiff, and more recent work on robust control strategies and adaptive schemes [8-11] which 
is valid for arbitrary joint stiffnesses. It is noted that implementation of most of these 
robust and adaptive controllers requires the calculation of very complex, manipulator- 
specific quantities, which limits the generality and applicability of these strategies. 

This paper introduces a new trajectory tracking controller for uncertain RLF.J ma- 
nipulators. In contrast with existing schemes, the present strategy is developed using an 
intelligent control approach which combines ideas from robust control and the recently 
developed performance- based adaptive control methodology [12,13]. This approach effec- 
tively exploits the underlying mechanical system structure of the manipulator dynamic 
model to permit reliance on information regarding this model to be eliminated, and as a 
consequence overcomes the difficulties associated with previous control methods. Thus the 
proposed tracking controller possesses a simple and modular structure, is easy toimple- 
ment. and requires virtually no information regarding either the mechanical or actuat or 
models. It is shown that the controller ensures uniform boundedness of all signals aiu 1 
provides arbitrarily accurate tracking control. 


2. Preliminaries 

Let define the position and orientation of the robot end-effecter relative to 

a fixed user-dcfkd reference frame and denote the vector of robot link coordi- 

nates. Then the for-ward kinematic and differential kinematic maps between the robot link 
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coordinates 9 and the end-effecter coordinates p can be written as 

P = h(!9), p = J(9)9 (1) 

where h : 5R n -> -ft" 7, is smooth and ./ £ K mxn is the end-effector Jacobian matrix. 

Observe that there are numerous advantages to formulating the manipulator control 
problem directly in terms of the end-effector coordinates p. For example, these coordinates 
are typically more task-relevant than the link coordinates 0. so that developing the con- 
troller in terms of p can lead to improved performance, efficiency, and implementability. If 
tlie manipulator is nonredundant (so that m = n) and is in a region of the workspace where 
J has full rank, then p and f? are diffeomorphic and this formulation presents no difficulties. 
A task-space formulation can also be realized if the manipulator is cinematically redun- 
dant (so that m < n) by utilizing, for example, the configuration control approach [e.g.. 
14, 15], In what follows, we shall consider nonredundant and redundant robots together 
and introduce a set of n task-space coordinates x obtained by augmenting p with n — m 
kinematic functions that define some auxiliary task to be performed by the manipulator 
[14,15], To retain generality, we shall require only that the kinematic relationship between 
6 and x is known and smooth and can be written in a form analogous to(l): 

x = h a (6), x = J„{6)9 (2) 

where h„ : 3fi n -> and ./„ • F' n " . Observe that for x to be a valid task-space 
coordinate vector the elements of x must be independent in the region of int crest: thus it 
will be assumed in our development that ,J a is of full rank. 

Consider an nlink RLFJ manipulator with actuator coordinates 0cK r, and actuator 
torques u e W. The task-space dynamic model for this manipulator system is a 4nth 
order differential equation relating the end-effector coordinates x and the system control 
input u: 


F = Hx -fi V cc ± + G, T = ,/J F (3a) 

u = J m 4> + K™, T (36) 

where F £ rft n is the generalized force associated with x, H(x) £j? n * n is the manipulator 
inertia matrix, V&(x, x)£)ft nx " quantifies Coriolis and centripetal acceleration effects, 
G(x) £ s JJ n is the vector of gravity forces, P £ T n is the vector of forces and moments 

exert ed by the end-effector on the environment, and J m , K,, n £ R nxri arc positive, constant , 

diagonal matrices which characterize the actuator dynamics. Note that in obtaining the 
RLFJ manipulator model (3) we have scaled H, V cc , and G by the joint stiffness, introduced 
the definition T = <j>- 9, and assumed that actuator rotor motion is a pure rotation 
relative to an inertial frame. It is well known that the rigid-link manipulator dynamics 
(3a) possesses considerable structure, For example, for any set of generalized coordinates 

x, the dynamic model terms H. G are bounded functions of x whose time derivatives H . G 
are also bounded in x and depend linearly on x, the matrix H is symmetric and positive- 
definite, the matrix V cc is bounded in x and depends linearly on x, and the matrices H 
and V cc are related according to H =V CC + V£. Additionally, V&(x: x) y = V&(x? yjxVy, 
and if y and y are bounded then V&(x; y) is bounded and V cc (x, y) grows linearly with x. 

In this paper we shall address the trajectory tracking problem. The control objective 
for tracking is to ensure that the manipulator/actuator system (3) evolves from its initial 
state to the desired final state along some specified task-space trajectory x,* (t) £ K n 
(where x,* is bounded with bounded derivatives). In what follows, it is assumed that the 
manipulator/actuator system state 9, 9, <f>, and <p is measurable. Observe that the dynamic 
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model (3) consists of two cascaded dynamical systems. One consequence of this structure 
is that the rig-id-link manipulator input T cannot be commanded directly, as is assumed in 
the design of controllers at the link torque input level, and instead must be realized as the 
output of the actuator' dynamics (3b) through proper specification of the actuator control 
input u. The structure of the RLFJ manipulator dynamics (3) suggests partitioning the 
control system design problem into two subproblems: regard T as the control input for 
the subsystem (3a) and specify the desired evolution of this variable T d(t ) in such a way 
that if T =Td then accurate tracking would be achieved, and then specify the actual 
control input u so that T closely tracks Th- This approach to controller design is adopted 
in this paper, so that the proposed control system consists of two subsystems: an adaptive 
strategy that provides the (fictitious) control input required to ensure that the system 
(3a) pm-forms as desired, and a robust control scheme that determines the (actual) control 
input u which guarantees that the system (3b) evolves with T closely tracking T fi . 


3. Tracking Control Scheme 

Let e = Xd - x denote the task-space trajectory tracking error and E = T,/ - T 
represent the link torque tracking error. Consider the following tracking controller for 
RLFJ manipulators: 


F (3 r =A(f)x ( i +R(t)xd + f(f) +&i7 2 w +k, 2 'y 2 e 
w = — 27W + 7 2 e 

T d =.TjF d ( 4 ) 

u =fo(f) + [b(f)sat(~)] +k a s 

where the notation [gh] =[gi^i, 92 ^2, .... fj n h n ] G (for any two n-vectors g. h) and 
sat(g) = [sat (#1), sat (#2), ■ ... sat (g n )] T £ (with sat(- ) the standard saturation function) 
is introduced, s = E+AE is the weighted torque-torque rate tracking error, f 0 (t), b(t)G 
are robust control terms. f(f) G s R n and A(t), B(t)e^R. nxn are adaptive gains! am I hi , k 2 , 
7, k a . 6, A are positive scalar constants. The robust control terms f., b are smooth vector 
functions which are defined in the proof of the Theorem below, and the adaptive gains 
f,/4, B are adjusted according to the following simple update laws: 

f = -crif + p t q 

A = -a 2 A + fM xj (5) 

B = -a 3 B + /d 3 qxj 


where q =e + ejki 7 — w/7 is the weighted and filtered position- velocit, y tracking error 
and the a - ,; and (3 t arc positive scalar adaptation gains. 

The stability properties of the proposed tracking strategy (4), (5) are summarized in 
the following theorem. 

Theorem: The control scheme (4), (5) ensures that (3) evolves with all signals (semiglob- 
ally) uniformly hounded provided 7 is chosen sufficiently large and bis properly defined. 
Moreover, the trajectory tracking error e,& is guaranteed to converge exponentially to a 
compact set which can be made arbitrarily small. 

Proof: Observe first that the actuator dynamics ( 3b) can be written 

JmA ~~ f m(@ • ® 1 0) U 
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where f m ( 0. 0 , cp, <p) is a smooth function obt ained through routine manipulation. Applying 
the control law (4) to the manipulator dynamics (3) yields the closed-loop error dynamics 

He + V cc e + ki'y'w + k 2 j~e + + ^A^-d + $BXd + V c d.e - •J~' 1 E = O 

g 

■J m . s + + [bsat ( — )] + fo - f m =0 ( 7 ) 


where $/=f-G.$a=A — H, $# = I? - E C( /, and the notation V C d = V7 e (x, x rf ) is 
introduced. 

C onsi der the Lyapunov function candidate 


V = \e T He -r ]-k 2 / y 2 e T e + ^Ayw T w + -^-e T He - -w T He 
22 2 A: 17 7 


1 


1 . 1 


+ -L„s + AyAE i E + - — + -trl — + — $£<]># 




/?2 


& 


( 8 ) 


and note that V is a positive-definit c and prop er function of the closed-loop system state 
if 7 is chosen sufficiently large. Computing the derivative of (8)along(7) and simplifying 
permits the following upper bound on V to be established: 


V < - \ m (Q*) || Zi || 2 —k a || E || 2 -k a \ 2 || E || 2 + 


& \r.ir 


Zi llll E|| - 


m 

ft min 


fit II 2 


, &2 k C c n 

+ e 

«i 7 


e r + 




w HU e |' 2 +i} 2 eH~- 

pmir 


(9) 


where A m (-),AM(-) denote the minimum and maximum eigenvalue of the matrix argument, 
respectively, k cc satisfies | | L cc || F < k cc || x || Vx, k c ,i is an upper bound on V c ,i, is an 
upper bound on || x,j ||, the >]i are positive scalar constants which do not increase as e is 
decreased and the ft t are increased, fo is any (nominal) estimate forf m (for example, fo =0 

can be used), b is chosen so that 6 j>max[l,( f mi - / 0l ) 2 ] for i = \. 2 n .j is chosen so 

that 7 > max[l, k 2 /k 1 ], z x = [|| e || || e || j| w ||] T . ^ = [|| $ / | || \\ F || \\ f ]T \ 

Pmin = min(/h ). ft ma X = ma x(fti), (T m in is the minimum singular value of the matrix 
J n (recall that J a is assumed to be nonsingular in the region of interest, so that<r m j n is 
nonzero) , and 


Q* = 


ho 

2ki 7 



( kcc^M 4 ~ k c d) 


0 


2fc^7 "h k C( j) 

-X„(H) -fy- i ^ 


0 

-A u(H)-ty 

k\ 7 


k. r r 'ij f 
2 T 


(note that Q* is positive-definite if 7 i s chosen large enough). Next let 2 2 = [| ; || || 

E || || E ||] T and 


and 


^ m 

m 

3,/ ( 2cr. m/ j n j (P 

0 
II 

1 

_oo 

&rnin ) 

Ka\ 2 1] 
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1 a| 


notice that Q is positive- definite if Ay is chosen large enough, 
inversely proportional to ft mtn and ft. 


max!%A r? f 'xed, then there 


If e is chosen to be 
exist positive scalar 
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constants 74, 7 5 that does not increase as 7 and (3 mm increase, and positive scalar constants 
A i independent of 7 and 0 mtn , such that V and V in ( 8 ) and (9) can be bounded as 


Ai || z' A 3 

Praia 

* <-(A m (Q) - — 1 /1/2 )|| Z ' || 2 

7 

Now choose two scalar constants Vm, V m so that Vm >V m > V(()} and define cm = 

(Q) 74 V M 1/2 It then choose 7 large enough so that c M > 0 (this is always possible). 

Let S = max(A,3 /cm -A4/A5) and choose (3q so that 75A/A) < (this is always possible) . 

Then selecting (3 min >(3 0 ensures that if V m < V <Vm then V < 0. This condition 
together with V M >V m , >R(0) implies that V(t) < Vm Vf, so that c(t)=A m (Q)- 

r/ 4 h 1 / 2 (t) /7 > cm > 0 Vt and 

2 ^5 

x> < -CM I *2 II A/3). II $ ||2 


z 2 


__A4 

Pirn 






|| / / ' + * 




where A (3 =(3 rn i n - (3 q and it is assumed that 0min is chosen so that A (3 > 0. The 
ultimate boundedness results developed in [13,14] are now directly applicable and permit 
the conclusion that || z 2 |J, |: \I> |i are uniformly bounded and that||z 2 |J.|| \l>|| converge 
exponent ially to the" closed balls B r , , B r2 , respective] y, where " 


r 1 


Sv 14 


T2 


Ai(A) + A/ 3) j 


- 


1/2 


Observe that the radius of the ball to which ||z 2 || 2 is guaranteed to converge can be 
decreased as desired simply by increasing A (3. ■ 


4. Conclusions 

This paper presents a new solution to the motion control problem for uncertain RLFJ 
manipulators. The proposed control strategy is simple and computationally efficient, re- 
quires little information concerning either the manipulator or actuator/transmission mod- 
els, and ensures uniform b oundedness of all signals and arbitrarily accurate task-space 
trajectory tracking. Future research will involve the implementation of the controllers for 
robotic applications in hazardous and unstructured environments. 
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